package cn.topevery.garden.wapi.utils;

import hw.topevery.framework.dto.PointDto;

/**
 * @author yang.yang
 */
public class CoordinateTransHelper {

    private static final double PI = 3.14159265358979324;
    private static final double X_PI = 3.14159265358979324 * 3000.0 / 180.0;

    private static final double[] MCBAND = {12890594.86, 8362377.87, 5591021, 3481989.83, 1678043.12, 0};

    private static final int[] LLBAND = {75, 60, 45, 30, 15, 0};

    private static final double[][] MC2LL = {{1.410526172116255e-8, 0.00000898305509648872, -1.9939833816331, 200.9824383106796, -187.2403703815547, 91.6087516669843, -23.38765649603339, 2.57121317296198, -0.03801003308653, 17337981.2}
            , {-7.435856389565537e-9, 0.000008983055097726239, -0.78625201886289, 96.32687599759846, -1.85204757529826, -59.36935905485877, 47.40033549296737, -16.50741931063887, 2.28786674699375, 10260144.86}
            , {-3.030883460898826e-8, 0.00000898305509983578, 0.30071316287616, 59.74293618442277, 7.357984074871, -25.38371002664745, 13.45380521110908, -3.29883767235584, 0.32710905363475, 6856817.37}
            , {-1.981981304930552e-8, 0.000008983055099779535, 0.03278182852591, 40.31678527705744, 0.65659298677277, -4.44255534477492, 0.85341911805263, 0.12923347998204, -0.04625736007561, 4482777.06}
            , {3.09191371068437e-9, 0.000008983055096812155, 0.00006995724062, 23.10934304144901, -0.00023663490511, -0.6321817810242, -0.00663494467273, 0.03430082397953, -0.00466043876332, 2555164.4}
            , {2.890871144776878e-9, 0.000008983055095805407, -3.068298e-8, 7.47137025468032, -0.00000353937994, -0.02145144861037, -0.00001234426596, 0.00010322952773, -0.00000323890364, 826088.5}};
    private static final double[][] LL2MC = {{-0.0015702102444, 111320.7020616939, 1704480524535203L, -10338987376042340L, 26112667856603880L, -35149669176653700L, 26595700718403920L, -10725012454188240L, 1800819912950474L, 82.5},
            {0.0008277824516172526, 111320.7020463578, 647795574.6671607, -4082003173.641316, 10774905663.51142, -15171875531.51559, 12053065338.62167, -5124939663.577472, 913311935.9512032, 67.5},
            {0.00337398766765, 111320.7020202162, 4481351.045890365, -23393751.19931662, 79682215.47186455, -115964993.2797253, 97236711.15602145, -43661946.33752821, 8477230.501135234, 52.5},
            {0.00220636496208, 111320.7020209128, 51751.86112841131, 3796837.749470245, 992013.7397791013, -1221952.21711287, 1340652.697009075, -620943.6990984312, 144416.9293806241, 37.5},
            {-0.0003441963504368392, 111320.7020576856, 278.2353980772752, 2485758.690035394, 6070.750963243378, 54821.18345352118, 9540.606633304236, -2710.55326746645, 1405.483844121726, 22.5},
            {-0.0003218135878613132, 111320.7020701615, 0.00369383431289, 823725.6402795718, 0.46104986909093, 2351.343141331292, 1.58060784298199, 8.77738589078284, 0.37238884252424, 7.45}};

    /**
     * WGS-84先转换为GCJ-02，再转换为BD-09
     *
     * @param wgsLng 经度
     * @param wgsLat 纬度
     * @return 百度坐标
     */
    public static PointDto wgs84Bd09(double wgsLng, double wgsLat) {
        //WGS-84先转换为GCJ-02
        PointDto gcjPoint = gcjEncrypt(wgsLng, wgsLat);
        //转换为BD-09
        gcjPoint = bdEncrypt(gcjPoint.getLng(), gcjPoint.getLat());
        return gcjPoint;
    }

    /**
     * BD-09先转换为GCJ-02，再转换为WGS-84
     *
     * @param bdLng 百度经度
     * @param bdLat 百度纬度
     * @return 火星坐标
     */
    public static PointDto bd09WGS84(double bdLng, double bdLat) {
        // BD-09先转换为GCJ-02
        PointDto gcjPoint = bdDecrypt(bdLng, bdLat);
        //再转换为WGS-84
        gcjPoint = gcjDecrypt(gcjPoint.getLng(), gcjPoint.getLat());
        return gcjPoint;
    }

    /**
     * GCJ-02 to BD-09
     *
     * @param gcjLng 火星经度
     * @param gcjLat 火星纬度
     * @return 百度坐标
     */
    public static PointDto bdEncrypt(double gcjLng, double gcjLat) {
        double x = gcjLng, y = gcjLat;
        double z = Math.sqrt(x * x + y * y) + 0.00002 * Math.sin(y * X_PI);
        double theta = Math.atan2(y, x) + 0.000003 * Math.cos(x * X_PI);

        PointDto result = new PointDto();

        result.setLng(z * Math.cos(theta) + 0.0065);
        result.setLat(z * Math.sin(theta) + 0.006);
        return result;
    }


    /**
     * BD-09 to GCJ-02
     *
     * @param bdLat 百度纬度
     * @param bdLng 百度经度
     * @return 火星坐标
     */
    public static PointDto bdDecrypt(double bdLng, double bdLat) {
        double x = bdLng - 0.0065, y = bdLat - 0.006;
        double z = Math.sqrt(x * x + y * y) - 0.00002 * Math.sin(y * X_PI);
        double theta = Math.atan2(y, x) - 0.000003 * Math.cos(x * X_PI);
        double gcjLon = z * Math.cos(theta);
        double gcjLat = z * Math.sin(theta);

        PointDto result = new PointDto();
        result.setLng(gcjLon);
        result.setLat(gcjLat);
        return result;
    }


    /**
     * GCJ-02 to WGS-84
     *
     * @param gcjLat 火星坐标纬度
     * @param gcjLon 火星坐标经度
     * @return 经纬度
     */
    public static PointDto gcjDecrypt(double gcjLon, double gcjLat) {
        PointDto result = delta(gcjLat, gcjLon);
        result.setLat(gcjLat - result.getLat());
        result.setLng(gcjLon - result.getLng());
        return result;
    }


    /**
     * WGS-84 to GCJ-02
     *
     * @param wgsLon 经度
     * @param wgsLat 纬度
     * @return 火星坐标
     */
    public static PointDto gcjEncrypt(double wgsLon, double wgsLat) {
        PointDto result = delta(wgsLat, wgsLon);
        result.setLat(result.getLat() + wgsLat);
        result.setLng(result.getLng() + wgsLon);
        return result;
    }

    private static PointDto delta(double lat, double lon) {
        // a: 卫星椭球坐标投影到平面地图坐标系的投影因子。
        double a = 6378245.0;
        // ee: 椭球的偏心率。
        double ee = 0.00669342162296594323;
        double dLat = transformLat(lon - 105.0, lat - 35.0);
        double dLon = transformLon(lon - 105.0, lat - 35.0);
        double radLat = lat / 180.0 * PI;
        double magic = Math.sin(radLat);
        magic = 1 - ee * magic * magic;
        double sqrtMagic = Math.sqrt(magic);
        dLat = (dLat * 180.0) / ((a * (1 - ee)) / (magic * sqrtMagic) * PI);
        dLon = (dLon * 180.0) / (a / sqrtMagic * Math.cos(radLat) * PI);

        PointDto result = new PointDto();
        result.setLat(dLat);
        result.setLng(dLon);
        return result;
    }

    private static double transformLat(double x, double y) {
        double ret = -100.0 + 2.0 * x + 3.0 * y + 0.2 * y * y + 0.1 * x * y + 0.2 * Math.sqrt(Math.abs(x));
        ret += (20.0 * Math.sin(6.0 * x * PI) + 20.0 * Math.sin(2.0 * x * PI)) * 2.0 / 3.0;
        ret += (20.0 * Math.sin(y * PI) + 40.0 * Math.sin(y / 3.0 * PI)) * 2.0 / 3.0;
        ret += (160.0 * Math.sin(y / 12.0 * PI) + 320 * Math.sin(y * PI / 30.0)) * 2.0 / 3.0;
        return ret;
    }

    private static double transformLon(double x, double y) {
        double ret = 300.0 + x + 2.0 * y + 0.1 * x * x + 0.1 * x * y + 0.1 * Math.sqrt(Math.abs(x));
        ret += (20.0 * Math.sin(6.0 * x * PI) + 20.0 * Math.sin(2.0 * x * PI)) * 2.0 / 3.0;
        ret += (20.0 * Math.sin(x * PI) + 40.0 * Math.sin(x / 3.0 * PI)) * 2.0 / 3.0;
        ret += (150.0 * Math.sin(x / 12.0 * PI) + 300.0 * Math.sin(x / 30.0 * PI)) * 2.0 / 3.0;
        return ret;
    }

    /**
     * 是否在中国范围内
     */
    public static Boolean outOfChina(double lon, double lat) {
        if (lon < 72.004 || lon > 137.8347) {
            return true;
        }
        if (lat < 0.8293 || lat > 55.8271) {
            return true;
        }
        return false;
    }

    /**
     * 百度经纬度转百度墨卡托
     * 调用示例BDWgs2bdMkt(116.424374, 39.914668)
     *
     * @param lng 百度经度
     * @param lat 百度纬度
     * @return 百度经模卡托
     */
    public static double[] bDWgs2BDMkt(double lng, double lat) {
        double[] cF = new double[10];


        lng = getLoop(lng, -180, 180);
        lat = getRange(lat, -74, 74);
        for (int i = 0; i < LLBAND.length; i++) {
            if (lat >= LLBAND[i]) {
                cF = getCFList(i, LL2MC);
                break;
            }
        }
        if (cF != null) {
            for (int i = LLBAND.length - 1; i >= 0; i--) {
                if (lat <= -LLBAND[i]) {
                    cF = getCFList(i, LL2MC);
                    break;
                }
            }
        }
        lng = cF[0] + cF[1] * Math.abs(lng);
        double cC = Math.abs(lat) / cF[9];
        lat = cF[2] + cF[3] * cC + cF[4] * cC * cC + cF[5] * cC * cC * cC + cF[6] * cC * cC * cC * cC + cF[7] * cC * cC * cC * cC * cC + cF[8] * cC * cC * cC * cC * cC * cC;
        lng *= (lng < 0 ? -1 : 1);
        lat *= (lat < 0 ? -1 : 1);
        return new double[]{lng, lat};
    }


    /**
     * 百度墨卡托转百度经纬度
     * BDMkt2BDWgs(12960443.0482317,4825875.77263255)
     * @param lng
     * @param lat
     * @return
     */
    public static double[] bDMkt2BDWgs(double lng, double lat) {
        double[] cF = new double[10];

        lng = Math.abs(lng);
        lat = Math.abs(lat);
        for (int cE = 0; cE < MCBAND.length; cE++) {
            if (lat >= MCBAND[cE]) {
                cF = getCFList(cE, MC2LL);
                break;
            }
        }
        lng = cF[0] + cF[1] * Math.abs(lng);
        double cC = Math.abs(lat) / cF[9];
        lat = cF[2] + cF[3] * cC + cF[4] * cC * cC + cF[5] * cC * cC * cC + cF[6] * cC * cC * cC * cC + cF[7] * cC * cC * cC * cC * cC + cF[8] * cC * cC * cC * cC * cC * cC;
        lng *= (lng < 0 ? -1 : 1);
        lat *= (lat < 0 ? -1 : 1);
        return new double[]{lng, lat};
    }


    /**
     * 取代cF = MC2LL[cE];
     * @param index
     * @param values
     * @return
     */
    private static double[] getCFList(int index, double[][] values) {
        double[] cFList = new double[10];
        System.arraycopy(values[index], 0, cFList, 0, 10);
        return cFList;
    }


    private static double getLoop(double lng, double min, double max) {
        while (lng > max) {
            lng -= max - min;
        }
        while (lng < min) {
            lng += max - min;
        }
        return lng;
    }

    private static double getRange(double lat, double min, double max) {
        if (min > 0) {
            lat = Math.max(lat, min);
        }
        if (max > 0) {
            lat = Math.min(lat, max);
        }
        return lat;
    }
}
